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Abstract 

In this paper, we study under which conditions the 
trajectories of a mechanical control system can track 
any curve on the configuration manifold. We fo- 
cus on systems that can be represented as forced 
affine connection control systems and we generalize 
the sufficient conditions for tracking known in the 
literature. The sufficient conditions are expressed 
in terms of convex cones of vector fields defined 
through particular brackets of the control vector 
fields of the system. The tracking control laws ob- 
tained by our constructions depend on several pa- 
rameters. By imposing suitable asymptotic condi- 
tions on such parameters, we construct algorithmi- 
cally one-parameter tracking control laws. The the- 
ory is supported by examples of control systems as- 
sociated with elliptic hovercrafts and ellipsoidal sub- 
marines. 



1 Introduction 

The tracking problem has gained an increasing in- 
terest, mainly because of its applications to robot 
manipulators as for instance to control the position 
of underwater vehicles [6] and hovercrafts [15| . The 
tracking problem appears when a particular trajec- 
tory has to be followed by a control system, but 
there is no control law for the control system that 
makes this trajectory admissible. Then, the best 
that can be expected is to find a control law, typi- 
cally oscillatory, that defines a good enough approx- 
imation of the target trajectory. 

The mathematical background in the tracking 
problem includes the averaging theory [16] as ex- 
plained, for instance, in [5]. The averaging tech- 
niques transform differential equations difficult to 
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solve into other differential equations whose solu- 
tions approximate fairly well the solutions to the 
first set of equations. This is useful to approximate 
solutions to differential equations that depend on 
time or on parameters. 

Differential geometry has provided a suitable 
framework to study in an intrinsic way typical 
mechanical control systems in engineering as, for 
instance, underwater submarines, aircraft models, 
hovercrafts and so on [5]. Here, we focus on forced 
affine connection control systems and generalize 
the sufficient conditions for tracking a trajectory 
that exist in the literature from a geometric view- 
point [5]. The existent results can be interpreted 
as first-order sufficient conditions because only the 
control vector fields and particular brackets, called 
symmetric products, between them get involved in 
the statement of the sufficient conditions. However, 
our conditions need longer symmetric products and 
so they are said to be of order higher than two. 

In [6] it was observed that the tracking is pos- 
sible for specific underwater vehicles, even though 
they do not satisfy the geometric sufficient condi- 
tions known in the literature. That motivates our 
research in order to obtain more general geometric 
sufficient conditions that ensure the tracking prop- 
erty for a wider range of control systems. 

The chances to be able to track get trajec- 
tory are related to some controllability requirement 
and to the avoidance of "bad" directions. In an in- 
formal way, these "bad" directions have to be inter- 
preted as directions that will not make possible to 
have the starting point in the interior of the reach- 
able set. (We refer to [5] for an accurate description 
of the obstructions to controllability in terms of the 
symmetric products and of particular vector-valued 
quadratic forms.) The sufficient conditions for being 
able to track unfeasible trajectories are also related 
to how nonholonomicity allows to enlarge the set 
of admissible velocities for the control system. In 
this regard, constructions of convex cones pQ, the 
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above-mentioned vector-valued quadratic forms [5] 
and some techniques similar to the ones in [12] have 
been useful for obtaining the constructions consid- 
ered here. 

The paper is organized as follows. Section [2] con- 
tains the necessary background in forced affine con- 
nection control systems and in chronological calcu- 
lus [2|. Section defines properly the notion of 
trackability and reviews the geometric sufficient con- 
ditions in the literature [S]. Sections S] and [S] contain 
the main contributions of the paper and some exam- 
ples to justify the utility of these results. 

2 Notation and preliminaries 

Denote by N the set of positive natural numbers 
and write No for N U {0}. Fix n E N. From now on, 
Q is a ra-dimensional smooth manifold and %{Q) 
denotes the set of smooth vector fields on Q. All the 
vector fields are considered smooth, unless otherwise 
stated. Let tq : TQ — > Q be the canonical tangent 
projection, a vector field X on Q defined along tq 
is a mapping X : TQ — > TQ such that tq o X = tq. 

2.1 Affine connection control systems 

The trajectories 7 : / — > Q of a Lagrangian mechan- 
ical systems on a manifold Q are minimizers of the 
action functional 

A L (j) = j L{t,i{t))dt 

associated with a Lagrangian function L : R x TQ — ► 
R. 

The solutions to this variational problem must 
satisfy the well-known Euler-Lagrange equations, 

d (dL\ dL 

d7 v ^J-^ = °' » = 1 '-' n . W 

where (q l ,v l ) are local coordinates for TQ. Here we 
consider controlled Euler-Lagrange equations ob- 
tained by modifying the right-hand side on the 
above equation, as follows: 

d (dL\ dL A ■ 

— -r — r = > U n Y„, I = 1, . . . .ft, 

x ' a=l 

with u a : I -> R, : Q -> R. 

When the manifold Q is endowed with the Rie- 
mannian structure given by a Riemannian metric g 
and the Lagrangian function L g (v q ) = \g(v q ,v q ) is 



considered, the solutions to ([T|) turn out to be the 
geodesies of the Levi-Civita affine connection V 5 
associated with the Riemannian metric. (See [S] for 
more details and for many examples of mechanical 
control systems that fit in this description.) 

When control forces are added to the geodesic 
equations we obtain an affine connection control sys- 
tem 

k 

V? (t) 7(*)=X;««(t)n(7(t)), 

a=l 

with Y a being vector fields on Q. 

The notion of affine connection control system can 
be extended without the need of the Levi-Civita 
connection. 

Definition 2.1. An affine connection is a map- 
ping 

V:X(Q)xX(Q) — ► X(Q) 

(X,Y) .— V(X,Y) = V X Y, 

satisfying the following properties: 

1. V is M-linear on X and on Y ; 

2. V fX Y = fV x Y for every f £ C°°(Q); 

3- VxfY = fV x Y + (Xf)Y, for every f e 
C°°(Q). (Here Xf denotes the derivative of f 
in the direction X.) 

The mapping VjF is called the covariant deriva- 
tive ofY with respect to X. Given local coordinates 
(q l ) on Q, the Christoffel symbols for the affine con- 
nection in these coordinates are given by 

v i = wl 

Wdq r f-f jr 8q*' 
1=1 

From the properties of the affine connection, we 
have 

i,j,r=l x ' 

where X = £™ = i X i d/dq i and Y = YJZ=i Y^/dq 1 . 

Definition 2.2. A forced affine connection 
control system (FACCS) is a control mechani- 
cal system given by £ = (Q, V, Y, & , U) where 

• Q is a smooth n-dimensional manifold called 
the configuration manifold, 

• Y is a time- dependent vector field along the pro- 
jection tq : TQ — > Q, measurable and bounded 
with respect to the time and affine with respect 
to the velocities, 
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• is a set of k control vector fields on Q, and 

A trajectory 7 : / C R — > Q is admissible for X if 
7 : / — > TQ is absolutely continuous and there exists 
a measurable and bounded control u: I — > E7 swc/i 
i/iai f/ie dynamical equations of the control system £ 

V^)7(*) = y(t,7(*)) + X) u «(*) y «W t )). ( 2 ) 

a=l 

are fulfilled (almost everywhere). 

The vector field y includes all the non- 
controlled external forces; e.g., the potential and 
the non-potential forces. The assumption that Y 
is affine with respect to the velocities means that, 
in every local system of coordinates (q l ,v % ) on TQ, 
Y can be written as 

n 

Y(t,v q )=Y (t,q) + ^2v i Y l (t,q). 

i=l 

Equation ([2]) can be rewritten as a first-order con- 
trol— affine system on TQ, 

k 

T(i) = Z(T(t)) + Y v (t, T(*)) + £ u a (t)y/(T(t)), 

0=1 

(3) 

where T : I — > TQ is such that tq o T = 7, Z is the 
geodesic spray associated to the affine connection 
on Q and Y^ denotes the vertical lift of the vector 
field Y a (see pQ for more details). 

Apart from the usual Lie bracket that provides 
X(Q) with a Lie algebra structure, the following 
product of elements in X(Q) associated to V can 
be introduced. 

Definition 2.3. The symmetric product is the 

map 

(•: •): £(Q) x X(Q) — > 

It can be proved that 

[Y a v ,[Z,Y b v ]] = (Y a :Y b ) v (4) 

(see 0). 

2.2 Chronological calculus 

We recall in this section some notion of chronological 
calculus, which is used later as a tool in the study 



of the asymptotic behavior of endpoint mappings 
depending on parameters. For a comprehensive dis- 
cussion and for the proofs of all results stated in 
this section see (2]. In the sequel all vector fields, 
autonomous and non-autonomous, are assumed to 
be complete. The behavior of non-complete vector 
fields on compact sets can be studied by considering 
suitable cut-off procedures. 

Given a non-autonomous vector field X T on some 
manifold M, where r denotes the time variable and 
the map (r,q) 1— ► X T (q) is assumed to be smooth 
with respect to q and measurable bounded with re- 
spect to r, we denote by exp J* * X T dr the diffeomor- 
phism of M onto itself corresponding to the flow 
from time to time t of X T . Hence, exp Jjj X T dr(q) 
is the evaluation at time t of the solution to the 
non-autonomous Cauchy problem 

q(r) = X T (q(r)), q(0) = q. 

Any diffeomorphism P : M — ► M defines an isomor- 
phism Ad-P of X(M) through the rule 

AaP(Y)(q)=P*(Y(p-\q))), 

where denotes the pushforward by P. 
If P = exp J X T dr, then we write 

AdP = exp / adA^-dr. 
Jo 

If ad^ X T (Y) = for some m £ N and every r, 
then 

exp fl adX T dr(Y) = Y+ f*[X T , Y]dr 

+ fi T f ' If ^ ' y ] d ^dri + • • • + 

Jo Jo" 1 ' ' ' la"' 2 ad ^r m _i o • • • o adX ri Fdr m _i • • • dn. 

(5) 

In the framework of chronological calculus the flow 
of the sum of two non-autonomous vector fields can 
be conveniently represented by the following varia- 
tion formula 

t ^ jtj X T + Yr)dT = ^ 
exp f X T dr o exp f Q (exp JJ" adA s ds) Y r dr. 

Let us recall a useful result for the convergence of 
flows of non-autonomous vector fields. It states, 
roughly speaking, that the flows converge if the vec- 
tor fields converge in integral sense. For further re- 
sults and a discussion on this kind of convergence 
from the point of view of ordinary differential equa- 
tions and control theory, see [31 [11] . 

Lemma 2.4. J! Lemma 8.10] Let Z ] T , j G N, and 
Z T , t G [0, t\\, be non-autonomous vector fields on 
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M, bounded with respect to t, and let these vector 
fields have a compact support. If 



Zldn 



Z T dr, j 



oo, 



then 



exp / Z 3 T dr — > exp / Z T dr, j 
Jo Jo 



oo, 



both convergences being uniform with respect to 
(t, q) G [0, ti] x M and uniform with all derivatives 
with respect to q G M. 

Another, even more standard, result on the con- 
vergence of flows is the following, that we find use- 
ful to state as a separate lemma. Its difference from 
the previous one can be described as follows: if the 
dependence on time of the Z° T is prescribed indepen- 
dently on j (it would be enough that they converge 
uniformly) , then the uniform convergence of flows is 
guaranteed by the uniform convergence of the vec- 
tor fields, even without any knowledge about the 
convergence of their derivatives with respect to the 
state variables. For completeness, we provide a brief 
proof for it. 

Lemma 2.5. Let Ai,...,A m G L°°{[0, h], R). Let 
Zr, n G N, and Z T , r G [0,ii], be non- autonomous 
vector fields on M of the form Z 3 T = Ai(r)Z^ + • • • + 

Am(r)Z^ and Z T = \\{r)Z\ -\ h A^t)^, with 

Zi, 



Zj,Zi G X(M) with compact support. If Z\ 



oo. 



then 



exp / Z 3 T dr — > exp / Z r dr, j 



oo, 



both convergences being uniform (the first with re- 
spect to the state q and the second with respect to 
(t,q)). 

Proof. Using the variation formula ([6]) with X T = 
Z T and Y T = Zi — Z T , we get 



exp Jq zldr = exp J" * Z r dro 
~ Jq (exp / T &dZ s ds) (Zi - Z T )dr. 



(7) 



Since (exp f Q T Z s ds)^, r G [0, ti], is a compact family 
of operators, then the last diffeomorphism in d?D 
converges uniformly to the identity for t G [0,ti] as 
j goes to infinity. ■ 



3 Tracking problem 



manifold, called reference or target trajectory, which 
is not a solution of the FACCS considered. A tra- 
jectory is successfully tracked if there exist solutions 
to the FACCS that approximate it arbitrarily well. 

Consider any distance d: Q x Q ^ R on Q whose 
corresponding metric topology coincides with the 
topology on Q. From now on / will denote the in- 
terval [0, t\], with t\ > 0. 

Definition 3.1. A control system £ is trackable 

if for every continuous curve 7: / — > Q, for every 
v G T 7 ( )Q and for every strictly positive tolerance 
e, there exist a control u e G L°° (I, U) such that the 
solution £ e : I — > Q to T, corresponding to u e and 
with initial condition £ e (0) = v verifies 

d( 7 (t),f(t))<e 

for every time t G /. 

Remark 3.2. Since any continuous curve can be 
uniformly approximated, with arbitrary precision, 
by a smooth curve having a prescribed tangent vec- 
tor at its initial point, then X is trackable if and 
only if every curve 7: / — > Q on Q of class C°° is 
trackable for S, i.e., for every e > 0, there exist 
u e G L°°(I,U) such that the solution £ e : I ^ Q 
to £ corresponding to u e and with initial condi- 
tion £ £ (0) = 7(0) verifies d(7(i), £, e (t)) < e for every 
t G /. 

In order to give some insights into particular suffi- 
cient conditions for tracking, we are going to review 
a result in the literature. 

Theorem 3.3. \5, Theorem 12.26] Let £ = 
(Q,V,Y,W,U) be a FACCS such that 

• the distribution generated by <3f = {Y±, . . . , 
is regular, that is, it is a subbundle of'TQ; 

• (Y a : Y a ) G span CO o( Q) ^ for every a G 
{l,...,k}, i.e., (Y a : Y a ) = Y^b=i a abY b , where 
Tab G C°°(Q); 

• the distribution Sym^^(^) de- 
fined by Sym^ 1 )^)^ = span R ^ + 
span R {(iy: Z)(q)\W,Z G ^} is the entire 
tangent bundle TQ. 



The need of trackability appears when one tries to 
follow a particular trajectory on the configuration 



Let 7 re f : / — > Q be a reference trajectory of class 
C 3 . Define the functions u rc f iQ , u re f & c : / — > R, 
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a, b, c G {1, . . . , k}, b < c, as solutions of class C 1 to 

V^ ef ( t )7 r ef(t) - Y(t,j ie{ (t)) 
k 

= ^^rcf,a(0' 5/ a(7ref(i)) 



a=l 



+ E n rcfibc (t)(y fe: y c )( 7ref (i)). 



De/ine u s i ow : / x TQ -> R fc , u osc : R x / x TQ 
R fc 



U 8 low,o(*)V g ) = «ref,a(*) + 



("rcf.hcW) 2 



E E 

6=1 \ c=b+l 
a-1 

Mo B c,a(T,t, U 9 ) = y^yio(e,a)(T) 
fc 

-| ^ U ref,ac(i) l ^lo(a,c)(' r ), 



Cab(<?), 



c=a+l 



a-1 



where lo(a, 6) = — j) + (6 — a) /or (a, 6) G 

3=1 

{1, . . . , A;} 2 , a < 6, and /or i G N 



TTien 7 rc f is tractable for £ and moreover the so- 
lutions £ e o/S, e > 0, corresponding to the controls 



u e :RxTQ 



U cR k 

^slow(^) ^g) "H T^osc (ji ^q) 



rai/i initial condition £ e (0) = 7 rc f(0) are such that 
d(7 re f (t), £ e (i)) tends to zero as e goes to zero uni- 
formly with respect to t G /. 

Remark 3.4. Observe that under the hypotheses 
of Theorem 13.31 not only the tracking is guaranteed, 
but also the tracking control law is given explicitly. 



4 A more general tracking result 

The idea of the following construction is to iden- 
tify, given the set a larger set of control vector 
fields J^i such that every trajectory solution of the 
FACCS obtained by replacing span C oo(Q)£^ by J^i 
can be tracked by solutions of the original FACCS 
S. Repeating the construction on Jff{ we obtain 
an even larger family Jfa and so on. If eventually 
Jti(q) = TgQ for every q G Q for some / G N, then 
we can show that the system is trackable. 



In order to generalize the sufficient conditions for 
tracking given in Theorem [331 we construct the fol- 
lowing set of vector fields on Q: 



span C oo ( Q) 



(9) 

^_ 1 -co{(Z: Z) | Z G L(J^_x)}, 

for I G N, where, for A C X{Q), L(A) = An (-A), 
co(A) denotes the convex hull of A, and A is the 
closure of A in X(Q) with respect to the topology 
of the uniform convergence on compact sets. For 
A C 3C(Q) we also write 

A(q) = {Y(q) | Y G A} C T q Q. 

Proposition 4.1. For every I G No, J% is a convex 
cone of ' SC (Q)- In particular, for every q G Q, <%i(q) 
is a convex cone with vertex at G T q Q. 

Proof. The proposition is proved by induction hav- 
ing in mind that the set Jft is a convex cone if it 
contains all conic combinations of elements of J#/. 
Remember that a conic combination of elements of 

Xi is of the form \{W\ H h \ r W r with A, G R> , 

Wi G Jtl for every i G {1, . . . , r}. 

First, J^o is subspace of X{ff) and thus it is a 
convex cone. 

The induction step consists of proving that if J££ 
is a convex cone, so is First notice that, if 

W G L(J#i) and A G R, then, by the induction hy- 
pothesis, \W G L{JQ and thus X 2 (W: W) belongs 
to {(Z : Z) | Z G L(J£i)}. Hence, J£i+i is the closure 
of the sum of two convex sets invariant by multipli- 
cation by any non-negative scalar. Therefore, J^+i 
is itself a convex cone. ■ 



Given two functions a, (3 : [0, T] 
2T 



At (a, (3) 



o 



a(s)ds 



o 



L let 
/3(s)ds) dr. 



We say that a sequence of smooth T-periodic func- 
tions V'j : R — > R, i G N, is Ax-orthonormal and 



zero-mean if §q 4>j{ T ) — for every j G N and 
AT(ipj,ip m ) = 5j m for j, m G N, where <5 jm denotes 
the Kronecker delta. 

For instance, the sequence defined in (JSJ), is Ay- 
orthonormal and zero-mean. 

Proposition 4.2. Lei £ = (Q, V, Y, ^, R fc ) 6e a 
MCCS and /a; v q G TQ, T > 0, m, . . . , n k G N, 
and w = . . . , Wfc) G L°°(I, M fc ). For every e > 
denote by £ e : I —> Q the solution of 

£(t) = Y(t,t(t)) 

k 



V 



+ j2- e ^J-) w a (t)Y a (e 

a=l ^ ' 
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with initial condition £ e (0) = v q , where (ipj)j^ is a 
Ax-orthonormal and zero-mean sequence. Let also 
7 : I — > Q be the solution of 

V W) ^(t)=Y(t,j(t)) 

k 

~ S n a n b W a (t)w b (t)(Y a : Y b )(j(t)), (10) 

a,b=l 

with initial condition 7(0) = v q . Then there exist 
C, eo > such that d(^(t), £, e (t)) < Ce for every 
t £ I and every e 6 (0, eo). 

Proof. The proof of this proposition follows from 
Theorem 9.32 in [5] by considering the function 
u a (t/e,t) that appears there as tp na (t/e)w a (t). ■ 

Remark 4.3. Theorem 13.31 follows directly from 
Proposition 14.21 (and is obtained as such in [5]). 
Therefore, some of the hypotheses of Theorem 13.31 
can easily be relaxed: first of all the distribution 
generated by W need not be a subbundle of TQ. 
Moreover, the hypothesis that Sym^^(^) = TQ can 
be replaced by the requirement that 

V 7 rcf W7ref(0 - Y(t,j Iei (t)) e Sym«(^) 7rcf(i) 

for every t £ I. 

Theorem 4.4. Let £ = (Q, V, Y, R fc ) be a 
FACCS. Fix a reference trajectory 7 re f : / — > Q 
of class C°° . If for every t £ I there exists I £ N 
such that J£z(7 r ef(i)) = T^mQ, then 7 ro f is track- 
able. Therefore, if for every q £ Q there exists I £ N 
such that Jti{q) = T q Q, then the control system £ 
is trackable. 

Proof. First of all, notice that the last part of the 
statement (the trackability of S) directly follows 
from the first one (the trackability of 7r e f), which 
is proved below. 

As the reference trajectory 7 re f is defined on a 
compact set and 7 re f is continuous, then Im7 rc f is a 
closed compact set. By hypothesis, for every t £ I 
there exists / £ N such that J^( , y Te {(t)) = T 7ref ( t )Q. 
So there exist n + 1 vector fields in J££ whose conic 
combinations at 7 re f (t) give the whole tangent space 
Tj ie( n\Q. The smoothness of these vector fields 
guarantees that this is still true in an open neighbor- 
hood Ut of 7ref(i)- hi this way we construct an open 
cover of Im7 re f . As Im7 re f is compact, there exists a 
finite open subcover of {Ut}tei given by Ut x , • • • , Ut r ■ 
For each ti there exists a different li £ N such that 
^i(7ref(*)) = T ~y Icf (t)Q for every t £ J~}(U ti ). Then 
/ = max{Zi, . . . ,l r } satisfies J^( 7ref (i)) = T 7ref ( t )Q 
for every t £ I. 



Moreover, there exists a partition of unity subor- 
dinated to the finite open subcover {Uti}i=i,...,r ( see 
|l(Jj ) that allows us to define a finite set of smooth 
global vector fields Z a in <%i such that 

Ni 

V 7rcf{t) 7rcf(t) - Y(t,j rc{ (t)) = ^A a (i)Z a ( 7ref (i)) 

0=1 

(11) 

for t £ /, Ni £ N, where A a : I — > [0, +00) is of class 
C°°. 

We introduce for a curve on Q the notion of 
having a regular parameterization on J^. A curve 
7: I — > Q admits a regular parameterization on 
J^i if there exist Jtyj £ N, Ai,...,Aat £ C(I) and 
Z±, . . . , Z^i £ ^% such that X a {t) > for every t £ I 
and a £ {1, ... , Ni} and 

Ni 

V 7(t)7 (t) - Y(t, 7 (t)) = £ Aa(t)Z ( 7 (t)). 

a=l 

Fix e > and let = 7re f. Then ^ admits a 
regular parameterization on J&[. We are going to 
prove by induction that there exists a finite sequence 
{£o> £ij • • • , 6} of curves on Q such that each £j sat- 
isfies £i(0) = 7 re f(0), admits a regular parameter- 
ization on J£i and d(£i(i),£j+i(t)) < e/Z for every 
i = 0, . . . , I — 1 and every t £ I. The induction 
step claims that: for i = 0,...,/ — 1 if there ex- 
ists : I — ► Q admitting a regular parameteri- 
zation on J^+i, then there exists I —> Q with 
£i+i(0) = £i(0) admitting a regular parameteriza- 
tion on J^i and satisfying d(£j(i),£i+i(i)) < e/l for 
every tG/. 

Let us prove the induction step for i. Let 
Z\, . . . , G J^i+i be the vector fields that de- 

termine the regular parameterization of Here 
we split the proof in two steps, considering first the 
special case: 

1. Z a = F a — G a with F a £ J€j, and 
G a £ co{(Z: Z) I Z £ L(J£i)} for every a = 
l,...,N i+1 , 

and then the general case 

2. Z a £ Xi-co{[Z: Z)\Z £ Lpft)}. 

Let us study case [TJ admits the parameteriza- 
tion 

N i+1 

J2*a(t)(F a -G a )(£ i+1 (t)). (12) 

a=l 



I. 



N 



Each G a is given by ^2a a>b {G a>b : G 0j6 ) where 



solution to 



6=1 



G a ,b G L(J^) and a a%b > 0. Then (fT2"j) becomes 



A', 



A„ 



0=1 



F a (&+i(t)) -£A a (t)a a , 6 (G a)6 : G a)6 )(£ i+ i(i)) 
6=1 

(13) 

The dynamics described in (|13p are of the same 
form as in (|10p as long as we take "3f = 

{Ga,b}a= l,...,N i+1 ;b=l,...,N a , and &n ah n a ,y = <W<W, 
W a ,b = y/Ka a ,b- 

Then by Proposition 14.21 the solutions to (|13|) can 
be approximated by solutions to 



A. 



0=1 



A n 



+ E7K 6 7 ^, 6 (t)G a , 6 (^(t)) 
b=i ei V£i/ 

(14) 

being (a, b) t— ► n ab any injective map from N x N 
to N and (V'j)jeN a Ay-orthonormal and zero-mean 
sequence. More precisely, there exist C^e^o > 
such that d(^ £i (t),^ + i(i)) < C^e.; for every i G I, 
€i G (0, ej ; o)- In particular, we can choose e, such 
that Cje, < e/L 

The finite linear combination of elements in 
J#i(£^(i)) for every t G / on the right-hand 
side of (|14p does not necessarily satisfy the non- 
negativeness of the coefficients. However, G ayb G 
L(J^i), so —G a ^ G L(J^). Then we can rewrite the 
coefficients of G a & as follows: 



^n ab ( ~) w ajb (t)G a>b = max {o, Vn a6 (~) } 
a,b(t)G a)b + max jo, -^n ob (~J } w atb (t)(-G a j 



Thus all the coefficients are continuous and non- 
negative. We can conclude that ^ admits a regular 
parameterization on J%. We define then = ^ 
and the induction step has been proved for i in the 
case [U 

Let us turn to case [2 We recall that the clo- 
sure appearing in Q is considered with respect to 
the topology of the uniform convergence on compact 
sets. Then there exist two sequences Fi G Jffi and 
G J a G co{(Z: Z) | Z G L(Xi)} such that F 3 a - G j a 
converges uniformly to Z a on a neighborhood of the 
curve Ci+i- F° r every j G N let : / — ► Q be the 



v 4i(t) ^ +1 (t)-r(t,^ +1 (t)) 

= £A a (i)(^'-G'£)(£| +1 (i)) 

o=l 



(15) 



satisfying £| +1 (0) = £j+i(0). Then, thanks to 
Lemma 12.51 Q , x converges to uniformly on / 
as j tends to infinity. Take j large enough such that 



d(£f +1 (t),£ m (0)< 



2/ 



for every t £ I. We can apply to the same 
reasoning as in the first case. Then solutions to (|15p 
are approximated by solutions to (|14p replacing 
by H' e \ F a by and G a>b by G^ 6 . In other words, 
there exist C{, e^o > such that d(£f ei (i), £ J i+l (t)) < 
Ci€i for every t G /, e.j G (0, e^o). Again, can be 
chosen in such a way that Cje, < ^ and we define 

&=ef\ Thus, 

d(6(t),6+i(t)) < d^tuU')) 

+ d(^ 1 (t),^ i+ i(t))<f 

and admits a regular parameterization on J#£. 
Hence, the induction step has been proved for i. 

After the induction, we end up with a curve £o on 
Q admitting a regular parameterization on J^o and 
such that 

l-i 

d(£ (i),7ref(i)) < £d(6(t),&+i(t)) < Ij = e 



i=0 



for every t G J. (Recall that £j = 7 re f.) Moreover, 
by compactness of I, 

e = e - maxd(£ (*),7ref(*)) > 0. 
tei 



As J^o = span COO (Q)^, we conclude from Lemma [231 
that there exist 9 a j G C°°(Q), a G {1, . . . ,Nq}, j G 
{1, . . . ,k}, such that the solution to 

v i{t) i(t)-Y(t,i(t)) 

N k 

= ££^(*)Mf(*))*s-(f(*)) 

0=1 j=l 

with initial condition £(0) = £o(0) — 7rcf(0) sat- 
isfies d(£(i), £o(t)) < e for every t & I. Thus, 
d(£(i),7ref(*)) < e for every t G /. 

Since £ is an admissible trajectory for X, we con- 
clude that 7 rG f is trackable for £ with the tracking 
control law given by = £)o=l A a (i)0 aj - (£(*)), 

j = 1, . . . , fc. ■ 
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Corollary 4.5. Let S = (Q, V, Y, <3f,R k ) be a 
FACCS. Define the following set of vector fields on 
Q fori £ N: 

J% = span coc(Q) ^, 

m= ^?_i-co{(Z: Z) |ZGL(^_!)}. 

(16) 

Fia; a smooth reference trajectory 7 rc f : I —> Q. If for 
every t G / i/iere exists I G N swc/i i/iai J^i(j Te f(t)) = 
T Jief r t \Q, then j TC { is trackable. Therefore, if for 
every q £ Q there exists I £ N suc/i i/iai J^i(q) = 
T q Q, then the control system £ is trackable. 

Proof. Let us prove by induction that 

M-^Jfi i £ No- 

It is trivial that J C/ (see © and (fTED). 

The claim now is that if J£f C then 
C J^l+i- By definition, an element in 
c^+i is of the form F — G with i 7 G and 
G G co{(Z: Z) \ Z £ L(J%)}. Since C 
then F G J^i and L(J%) C L(j£). So G G 
co{(Z: Z)\Z £ L(J&i)}. We can conclude that 

By hypotheses, for every t £ I there exists Z G 
N such that J^(7pef(t)) = T 7rcf(t) Q. As ^ C 4, 
we have ^(7 re f(i)) = T^j t \Q. The hypotheses of 
Theorem 14.41 are satisfied, so the result holds. ■ 

Remark 4.6. If one follows the proof of Theo- 
rem 14.41 under the stronger hypotheses of Corol- 
lary 23J then each step of the induction procedure 
is of the type considered in case[TJ This will be im- 
portant in the next section, where we will turn such 
procedure in an algorithmic construction. 

Corollary 4.7. Let S = (Q, V, Y, &,R k ) be a 
FACCS. Define the following sets of vector fields for 
I £ N, 

% =2fi-i U {(Z a : Z b ) | Z a , Z b £ (17) 

If there exists I £ N such that sp&n R 3fi(q) = T q Q for 
all q £ Q and for each i £ {0, . . . , Z — 1}, for each 
Z £ (Z : Z) £ span C cx 3 (Q)^ J then the system £ 
is trackable. 

Proof. Let us prove by induction that 

span COO (Q)^ C J^, i £ No- 

Once this inclusion is proved Theorem 14.41 guaran- 
tees the trackability of the system. 



It is trivial by definition that span Coo (q) 2?q C J£q . 

Assume that span COO (Q)J^ C J££ and let us prove 
the inclusion for i. S ince J&i+\ is a convex cone 
by Proposition 14.11 and span C oo (q) C J^t+i, it is 
enough to prove that a(Z a : Z b ) belongs to J^+i 
for Z a ,Z b £ % and a £ C°°(Q). Thanks to ® 
and to the hypotheses on the symmetric products 
of elements of 

(aZ a : Zb) £ a{Z a : Z b ) + span coo( Q) J^, 
{aZ a : aZ a ), (Z b : Z b ) £ span C oo( Q) ^. 

Hence the symmetric product 

(aZ a - Z b : aZ a - Z b ) 

belongs to — 2a(Z a : Z b ) + span coo iq\ . Thus, 
a(Z a : Zb) belongs to span C0O (Q)i?i — ^(aZ a — 
Zb'. aZ a — Z b ), which is contained in J^+i- ■ 

Remark 4.8. The proof above actually shows 
that, under the assumptions of Corollary 14.7} 
span C oo(Q)5i C Jffi. It is easy to check that, in 
addition, = span C oo(Q)^. 

Remark 4.9. The main interest of Corollary 14.71 
is that its hypotheses are formulated in terms of a 
finite set of vector fields, in contrast with the infinite 
family of vector fields considered in Theorem l4.4l and 
Corollary 14.51 

4.1 Examples 

Let us consider some examples of mechanical sys- 
tems for which the above results guarantee the 
trackability, but Theorem 13.31 could not guarantee 
it. 

4.1.1 Hovercraft 

Consider an elliptic hovercraft moving on the sur- 
face of a fluid, identified with M. 2 . The configura- 
tion manifold is Q = S 1 x M. 2 with local coordinates 
(9, x\, X2) where 9 is the attitude and (xi, X2) is the 
position of the center of symmetry of the hovercraft. 
Let uj and (t>i,t>2) be the standard angular and lin- 
ear velocity, respectively, of the hovercraft with re- 
spect to a body-fixed coordinate frame attached at 
the center of symmetry of the body and whose axes 
coincide with those of the ellipse. Assume that the 
center of mass according to that body-fixed coordi- 
nate frame is on the horizontal axis and is different 
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from the center of symmetry. Then the added iner- 
tia matrix is the following 3x3 symmetric matrix: 





(a 





c 


M = 





e 






\c 








with a, c, e > (see [9J, [T3] for more details). Denote 
the corresponding impulse vector by (II, Pi, P 2 ) that 
is related to the velocities through the inertia matrix 
Ai as follows 













Vl 









The dynamics of the systems governed by the Kirch- 
hoff equations in dimension 2 with two controls are 




where wr 1 = {—W2,w\) denotes the rotation by tt/2 
of a vector w = (101,^2) m The control vector 
fields are Y 1 = (1, 0, 0) and Y 2 = (0, 0, 1). They cor- 
respond to the external torque, usually called yaw, 
and the external force, usually called surge, applied 
to the body. Let W = {Y U Y 2 }. 

The drift term Z appearing in ([3]) is, for the 
mechaincal system considered here, the vector field 
corresponding to the uncontrolled Kirchhoff 's equa- 
tions (notice that Y = 0). Using @ we can compute 
(Yi : Yi) = (0, 2c/e,0). The sufficient conditions for 
tracking given by Theorem 13.31 are not satisfied be- 
cause (Yi: Yi) ^ span C oo(Q){Yi, Y 2 }. 

However, due to Corollary 14.51 tracking is possible 
because 

M{{q) = T q Qyq £ Q. 
Indeed, for w\,W2 G C°°(Q), 



{w{Yi + W2Y2 : w{Yi + w 2 Y 2 ) 



e span C oo {Q) J 



-(0, 2cw\ + 2e Wl w 2 , 0)+ 2 w l Y i {w j )Y j , 

where Yj(iMj) denotes the Lie derivative of Wj with 
respect to Yi. In particular, taking as wi any 
nonzero constant function, we get 

span C oo (Q) (0,1,0) C ^-co{(Z: Z) \ Z € L(J#b)} ■ 

So we conclude that J4?i(q) = T q Q for all q G Q. 



4.1.2 Submarine 

Let us apply Corollary 14.71 to determine the track- 
ability of a particular control system describing the 
motion of a submarine. The system corresponds 
to the case 7 = considered in [B]. It models a 
neutrally buoyant ellipsoid vehicle immersed in a 
infinite volume fluid that is inviscid, incompressible 
and whose motion is irrotational. The dynamics are 
obtained through Kirchhoff equations [9] and have 
a particularly simple form due to some symmetry 
assumption on the distribution of mass (see [6J for 
details and also [H] for general overview of control 
motion in a potential fluid). 

Consider the coordinates (u, v) for the angular 
and linear velocity of the ellipsoid with respect to 
a body-fixed coordinate frame. Then the impulse 
(II, P) of the system is given by 



M 



where, under the symmetry assumptions mentioned 
above, 

M = diag(Ji, Ji, J 3 , Mi,M 2 , M 3 ) 

with Mi ^ M 2 , where diag(Ji, J±, J3) is the usual 
inertia matrix and Mi , M2 , M3 take into account the 
mass of the submarine and the added masses due to 
the action of the fluid. 

The configuration manifold Q for this problem 
is the Special Euclidean group or the group of 
rigid motions SE(3), which is homeomorphic to 
M 3 x 50(3). Let (r,A) G SE{3) be the posi- 
tion and the attitude of the ellipsoid. Denote by 
S: ffi 3 — ► so(3) the linear bijection between M 3 and 
the linear algebra so (3) of SO (3) such that 






-X3 


x 2 


X3 





-Xl 


-x 2 


Xl 






S(x 1 ,x 2 ,x 3 ) = 

The dynamics of the controlled system are given by 
Hr H A 

- =Av , W = AS(.), (18) 

and 



dn „ n ( Ul \ dp n (° 
- = nx.+px, + ^ 2 j, _ = px w+ ^o 

(19) 

The control vector fields are Yi = d/dHi, Y 2 = 
d/dH2 and Y3 = d/dP^. They correspond to a lin- 
ear acceleration along one of the three axes of the 
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submarine and to two angular accelerations around 
the other two axes. 

Due to Theorem 1.2 in [6], we know that system 
(flBD-lUSt is trackable. 



then 



f 

Jo 



f(s/e,s)ds 



This case cannot be recovered from Theorem 13.3 
because 

SymW(^) / TQ. 
Indeed, it can be computed that 

M 3 d 



f(s)ds + 0(e 



+ 0(e\\d 2 f\U 



(Yi: Y 2 ) = 0, (Y 2 : Y 3 ) 



Mi 5Pi 



(Yi : Y 3 ; 



M 3 d 

W 2 ~cW 2 



However, this case is covered by Corollary 14.71 
with 1 = 2, because 

0= (Y i: Yx) = (Y 2 : Y 2 ) = (Y 3 : Y 3 ) = 
= «Y 2 : Y 3 ): (Y 2 : Y 3 )) = ((Yy : Y 3 ) : <Y : Y 3 )), 

<«:«>:«:«» 



/or e close to zero, where f(s) = (1/T) J f(r,s)dr 
and d 2 denotes the 'partial derivative with respect to 
the second variable. 



5.1 Case 

As noticed in Remark 14.61 the hypotheses of Corol- 
lary 14.51 guarantee that every step of the induction 
argument proposed in the proof of Theorem l4.4l falls 
in the framework of case Q] (see page [6|). Hence, 
starting from a parameterization 



J 3 VMx M 2 J dU 3 V Wt) 7ref(*) " Y(t,7rcf(t)) = £ A a (i)^( 7ref (t)) 



Thus, (Z: Z) = for every Z € 
iF 2 and T q Q = span R J* 2 (t/) = 
span M {Y 1 (g),Y 2 ( 9 ),Y 3 ( g ),(Y 2 : Y 3 )(q), (Y 1 : Y 3 )(q), 
((Y 2 : Y 3 ): (Y 1 : Y 3 ))(q)} for all q E Q. 

The model studied in [6] can therefore be handled 
with the techniques proposed here. In particular, 
we can obtain for it one-parameter tracking control 
laws, as explained in the next section. 

5 One— parameter tracking con- 
trol laws 



a=l 



of 7 rc f : I — > Q, with Z l a E M{ and A a smooth and 
non-negative on / for every a = 1 , . . . , iVj , we can 
construct algorithmically a /-parameter family of 
admissible trajectories £ ei >'"> £ < of £ with e±, . . . , e; > 
such that = 7 re f, the uniform limit 



£1,. ..,£(. 



lim lim ••• lim £ e i>-' e * (20) 

£i^0 £;_!-+() £;_ i+ i^0 



exists for every i = 1, . . . , I and every ei, . . . , ej_j > 
and satisfies 



The aim of this section is to provide an algorith- 
mic implementation of the results obtained in the 
previous one about the existence of controls yield- 
ing tracking. This will be done separately under the 
hypotheses of Corollaries 14.51 and 14.71 using two dif- 
ferent algorithms. The first one is based on the pro- 
cedure proposed in the proof of Theorem 14.41 while 
the second one exploits the construction proposed 
in [5] and recalled in Theorem 13.31 

In both cases we will consider a reference trajec- 
tory 7 rc f : / — > Q, which is assumed to be of class 
C°°. 

A simple, albeit crucial, fact that will be used 
several times in the following sections is stated in 
the lemma below. 

Lemma 5.1. If f : K x I — ► M., (r, s) i— > /(r, s), is 
smooth on M. x / and T-periodic with respect to t, 



v 4 n,...,n-, (t) 4 ei, -' e ^w-n*,i ei, - ,e! - i w) 

e^r'l*))- (21) 

We also write ^g 1 '""' 6 ' for £ e i>— > e i. It is important to 
notice that the order of the limits in (|20p cannot in 
general be reversed. 

Let us recall to which extent the construction is 
algorithmic. Fix any injective map j : N x N — > N. 
By backward recursion on i, if I_ * satisfies 

v 5 i...-.s-« w er-- Q - 4 (*)-y(t 1 g 1 -- Q - 4 (t)) 

Ni 

= Y,^ l - t m i a(^ M (t)) (22) 

a=l 

with Aa 1 '"" 6 '"' E C(I, [0,+oo)) and Z l a E J^, then 
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ei,...,ez_i + i 



CI 



is defined as the solution to 



_ y(t) ^ r>e! _ i+1(t)) 

AT; 



x;(Aa i '-' ei - i (t)^- i (eT" e! ^ +i w)+ 



TV* 



/"ll— 1 /£ e li---> e i-i + l 



(*)) 



(23) 



with ; - l+1 (0) = 7 ro f(0), where 

Zl = K~ l -i2<i^:G^) 

6=1 

and Ft 1 € ^-i, G^ 1 G L(^_i), a^ 1 > 0. 
Recall that (i/'jOjeN is a AT-orthonormal and zero- 
mean sequence, for some T > 0. Each Aa 1 ' "' ,{E '~ l+1 (•) 
is either equal to some A a lv "' or is of the form 



A- 



ei,...,ei_ 



'(■)a 



i-l 



max <^ v\l) j{ a, b ) 



.0 



with t> equal to 1 or — 1. 

We choose (V'jOieN as follows: we require ipi to be 
positive in (0, T/2) and to annihilate, together with 
all its derivatives, at and T/2. We also require it 
to satisfy 



and we extend it by 



Mt), t G 



0, 



t G 



T 



and by T-periodicity over R. Finally we normalize 
tpi in such a way that Ar(^i,^i) = 1. Then we 
define ipj by 

iPj(t) = 2^1 (2 j t). 

Such choice of (V'jOjeN is motivated by the prop- 
erty that, for every choice of j G N, / € No and 
u G { — 1,1}, the function i \J max {u^j (i) , 0} is 
smooth. In particular, by backward recursion, each 
^ei, - g smoo ^] 1 an j j g foe product of functions of 



the type 2 ^J i max ^vtpj ^— ^ ,o| and of 2 \/Afc for 
some m G Nq and some b G {1, . . . , A/}. 



An important consequence of this factorization, 
which will be exploited in the proof of Theorem 15 .21 
is that the derivatives of y Aa 1 ''"' 6 * with respect to 
time can be bounded by a finite constant depending 
explicitly on ei, . . . , 

The smoothness of Aa 1 ''"' 6 *, moreover, allows us 
to consider Aa 1 ''"' 6 * Z l ~ l smooth vector field 

on the extended manifold R x Q and, similarly, 
\ e a'"'' tl ~ l {Z l a ) v as a smooth vector field on the ex- 
tended manifold R x TQ. 

Summing up, the trajectories of the /-parameter 
family ^q 1 ' '"' e * = £ ei '---> e i are driven by a /-parameter 
family of control laws u ei '—' €l G C°°(/,R fc ) depend- 
ing smoothly on e±, . . . , e\. The construction of The- 
orem 23] can be summarized as follows: given e > 0, 
if 

< ei <C e z _i <C ■ ■ ■ <C ei < 1 (24) 

then d(£ £1 '-> ei (t),7 ref (t)) < e for every t G /. Our 
aim is here to quantify the relations in (|24p. More 
precisely, we introduce I — 1 functions 772, ■ ■ ■ ,rji : 
(0, +00) — > (0, +00) and we look for asymptotic con- 
ditions on their convergence to zero at zero such that 

limd(f ■'»(e),'J30TB( e ),...,i»o...otB( e )^ j7irf ^j = 
e— >0 

(25) 

uniformly with respect to t G /. Let 77, = 77, o 
• • • o r/2 for i = 2, . . . ,1 and define 171 as the iden- 
tity on (0,+oo). We say that e i-> u*7i( e )'-.^( £ ) is a 
one-parameter tracking control law for 7 rc f if (|25p 
holds true. 

Theorem 5.2. Ze£ £ = (Q, V, Y, ^, R fc ) 6e a 
TylCCS. Let J%, i G N , 6e denned as m (EI|). Fix 
a reference trajectory 7 rc f G C°°(I,Q) and assume 
that there exists I G N suc/i that 

V 7r fW7rcf(t) " Y(t, 7rcf (t)) G J^(7ref(*)) 

/or every t E I. Construct £ 61 y> e i > u e ^y-^i and 
fji as above. If rji : (0, +00) — ► (0, +00) satisfies 
limsup e ^o ? ?i( e )/ e3 < 00 / or etiery i = 2, . . . ,1, then 
e 1 ► -^^1 (e),...,r?i (e) ^ ffl one -p arame t er tracking control 

law for 7 re f. 

Proof. The first step of the proof consists in esti- 
mating the order with respect to e of the L°°-norm 
of the time-dependent parameters appearing in the 
parameterization (|22j) . We write 6j for r)i(e). Denot- 
ing by C any constant not depending on the ej , it is 
easy to check by backward induction on i = 0, . . . , I 
that 



l A a I 



< 



c 
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Exploiting the factorization of Aa 1 ''"' 6 * described 
above we get, in addition, 



dt r 



for m G Nn 



< 



c 



Consider the extended system on R x TQ asso- 
ciated with Q where the time is the new variable. 
In the following computations we write, using the 
notation introduced in (1231). 



<I>' 

* a 
1 a,b 



(l,Z + Y v ) 
(0, (Gl b ) v ) 



all seen as vector fields on R x TQ. We also define 
TrefW = (0>7ref(0)) and, given a smooth function 
A : / — > R, we write A^ to denote a smooth function 
on R x TQ such that A y (t, v) = \(t) for every t G / 
and every u G TQ- In particular, we define 



7 a,b 



J a,b 



a:, 



- / \ei,->ei_,Z-i-l 

— \/Aa a ab 



df 



Then, applying (jSJ) and (jSJ), 

(t,eo 1 '-' £i (t)) = 

^p/o(^ e + ESi AJ-^WCO, (Z° a ) v ))ds 7r e cf (0) 

+ J E£l E£l ^j(a,b)(fi)\/ A «' 

C)^7 r e c f(0) 



•W*2 



,ei,...,e;_i 



+ E£i Jo H-M) (t) d f t r ^' ^ 

_/j«-l-n0 \ _ x^Ni \^ N a> r s 1,1, fsi\ 

°a,b 1 a,b) <L,a,a'=l l^b=l 2^b'=l Jo e, ^j(a,&H ei ) 

JT i^,b' ) (f)ds d Sl e l - b 1 e l jl, 



From now on, let us denote by "¥ any vertical flow, 
i.e., any flow on R x TQ preserving the base point 
on Q. 

Notice that, by construction, 

J2a=l Aa 1 ''"' e! ~ 1 0)$a+ 



E^a'=l Eb=l Ey=l MV^), ^'(a',6')) 



Aa 1 ' 



(0, : GS^> V ) = E£i A?'" ,e, 00(O, (Z a T). 



Then, 



(*,#•••••«(*)) 



ro 5$JJ(x e + E£i^-- <| - 1 W(o,(^) v ) 
+ E^i E£i Jo |^(a I 6)(t)d S0 (^ 1 [r° 6> x e ] 



-lpO 

+ ES'=1 E£ E6'=l(MV>i(a,&), ^i(o',6')) 

(0,<^:^W«: 6 1 ^)d^(0). 

Applying iteratively the same computation as 
above, one ends up with 

(*,#--«(*)) = 

^e?pj ' (A- + A a ( S )(0, (Z^) + ^( S )) ds 7r e ef(0), 

where 2?{s) is a sum of terms of the form C( S )V 
where V is a vector field on R x TQ independent of 
the €j, while £ : I — > R is smooth, depends on the 
€j and is of one of the following four types: 



Us 



= - Jo i^M)(t)^o^V A - 1 "" ,e " 1 ( s ) a S' 



2(A T (^(a,6) 5 ^i(a',6'))) 



, A , 1) ..., ci _ 1(s)A e v .. 

for i = 1, . . . , I, or 

c*w = -(/ *^iW)(S)^o 

(/o^W)(t)d*o 



ei,...,ei_i 



for z > j, i,j G {1, . . . ,1}. 

According to Lemma \2A\ the theorem is proved 
if we show that, for every £ of one of the four types 
introduced above, fg£(s)ds converges to zero uni- 
formly with respect to t 6 7 as e goes to zero. 

This can be done by applying Lemma [5. 11 Taking 
for instance 



f(r,s) = J ^ jia , b) (s )ds ^X^- ' e, - 1 («)<6, 

and e = 6i leads to 

"* e- 
Ci(s)ds < C 3—. 



Similarly, 



(2(s)ds < C - — 
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Taking 

/( T > s ) = Ho 4>j{a,b) (so)dso) (£ i>j{a>,b<) (so)dso) 



« ei,...,6i_i / \ » ei,...,e<_i / \ /— i I— i 
A « i S )K' ( S ) a a,b a a>,b> 



we obtain 



Finally, with 



f( T , s ) = (/o /€j ^j(a,b)(so)dso^J (Jo ^j(a',b')(so)<iso) 



we get 



1 



Notice that the upper bound for J Q * (2{s)ds is the one 
growing faster as e goes to zero. Indeed, in order to 
compare it with the one for (z(s)ds it suffices to 
notice that 
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V^l 2 v /i 2'"v /5 i r 2 e i-l 



converges to zero as e goes to zero. 

Hence, for each £ as above, there exists % = 1, 
such that 

/*C00d* < c ^ _ 

and we are left to notice that 



5 — 



i/ e i-2 



2^ — 2/62 2* — ^ 



^1-2 y 

tends to zero as e goes to zero. ■ 

Remark 5.3. The hypothesis 

limsup e ^Q77i(e)/e 3 < oo has been chosen, in 
the statement of Theorem 15.21 because of its sim- 
plicity. However, we can weaken it by requiring that 
limsup e ^ ?7j(e)/et +a < oo with a = ^ — 1 ~ 0.12. 
Indeed, with this choice of a, 




so that 



>I 2 -^a-^i=a«?_i 



\ e i-2 / \ e i-3 , 



Hence, each J *£(s)ds goes to zero uniformly with 
respect to t G / as e tends to zero. 



5.2 Case 

Analogously to Section 15.11 the aim is to provide an 
algorithmic implementation of the results obtained 
in Section [J] about the existence of controls yield- 
ing tracking but this time under the hypotheses of 
Corollary 14.71 Instead of adopting the algorithmic 
scheme on which the proof of Theorem 14.41 is based, 
as done in Section 15.11 we rely here on the itera- 
tion of the scheme proposed in [3] and recalled in 
Theorem 13.31 (see also Remark I4.3|) . The advan- 
tage is that, under the more restrictive hypotheses 
of Corollary 14.71 we can base the iteration scheme 
on the A^-orthonormal and zero-mean sequence de- 
fined in ([8j) using trigonometric functions, which is 
more convenient for numerical implementation than 
the sequence (V>j)jeN constructed in the previous 
section. 

We start from a parameterization 



A', 



V^ ref ( t )7ref(t) 



n*,7rcf(*)) =I>a(*)^(7ref(*)) 



a=l 



(26) 

of 7 ro f : I — > Q, with Z l a G i2J and A a smooth on 
/ for every a = 1, ...,JVj. (For the definition of 
Sfi, see (fTT|) .) As in Section I5TT1 we can construct 
algorithmically a /-parameter family of admissible 
trajectories £ ei >— > e « of T, with e±, . . . , e\ > such that 
6 = 7ref) the uniform limit in (|20p exists for every 
i = 1, . . . , I and every ei, . . . , > 0, and, instead 
of (f2Tj) . it satisfies 



'(/) 



ei, —M- 



*(t)-Y(t,i 



'(*)) 



G span R (J^(& 



The algorithm works by applying, at each step, 
the construction of Theorem 13.31 with 3?i as & (see 
Remark 14. 3p . Then by backward recursion on i, the 
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solutions to 

v^,....^ ((t) g 1 -^- 4 (t)-y(t 1 § 1 -^- 4 (t)) 

a=l 

Ni 

+ E ^■■■• e, -«(*)(2*- i :2r i >(^r , "- e, - i (*)) 

b,c=l,b<c 

for G are trackable by solu- 

tions to 

v^ r ^i (t) £r e '~* fl w - y(i,^'-' e! - i+1 (i)) 
= E Ofe? - ^) 

a=l 

+^^ £, - i (^-w ) t))t 1 (Cr' ew+1 (*)) 

(27) 

where u?'"'' 1 1 and u sc,o ' 1 are constructed as in 
Theorem 13.31 Notice that 

«la"'W + — ^ Uosc^W^+l,*) 
e i-i+l 

plays the role of a A| 1 '"'' ei_i+1 (t) or a ^™- e «-*+i (i) 
at the next step. 
We have 

K^/rioo < Cmax(||A' 1 -- £ '- 1 || 00) ||A^"- e '-'||2 ), 
||<-a £! - ! lloo<C'max(||A^-- e! -1 00 ). 

b,c ' 

Given a,/3: [0, T] X I — > E, define A T as 

A T (t,a,P) = 

W Jo (Jo a ( s ' *) ds ) (Jo *) ds ) dr - 
The construction of u s i ow and u osc is such that 

E ""slow'a ~ l ( t ) Z% a 1 
0=1 

b,c=l A n*,«osc,& > W °sc, C J(4 • Z c / 
iV*-l 

= e tf'-'^wt 1 

0=1 

+ E C^-^r^r 1 } 

6,c=l,6<c 

(see [5]). As in Section T5. 11 our aim is here to quan- 
tify the relations in (|24p . We will use the same no- 
tations for rji and rji as in Section 15.11 The notion of 
being a one-parameter tracking control law for 7 rc f 
is again defined through (f25j) . 



Theorem 5.4. Let £ = (Q,V,Y,W,R k ) be a 
FACCS. Let 3?i, i G No, be defined as in flTp satis- 
fying the same hypotheses as in Corollary \4- 1\ Fix 
a reference trajectory 7 rc f G C°° (L, Q) and assume 
that there exists I G N such that 

V iref (t)7ref(t) " F(t,7ref(t)) G ^(7ref(*)) 

/or every t G J. Construct £ ei >— > e ' ; u e iv,e ; fln( ^ 
?}j as above. If rji : (0, +oo) — ► (0, +oo) satisfies 
limsup £ ^ ?7i(e)/e 4 < oo /or et>ert/ i = 2, . . . ,1, then 
e i — ^ ■u*M ,E )'---i , 7i( e ) j S a one-parameter tracking control 

law for 7 r ef. 



Proof. The first step of the proof consists in esti- 
mating the order with respect to e of the L°°-norm 
of the time-dependent parameters appearing in the 
parameterization (|27p. Once more we write ei for 
fji(e). By induction it can be proved that 

II am ei,...,6i|| < fi( e .,, %e . ,-rnH-l\-l 

\\ a 2 u osc,a Woo S u i^ei • • • e t _ie^ j 

for every m G No- 

Consider, as in the proof of Theorem 15.21 the ex- 
tended system on R x TQ associated with Q. In 
the following computations we write 

K = (o,(^) v ), 

W{ c = (0,(Zl.Zi) v ). 

We also write Uosc,'o e * (c) to denote (tiosc,'a' €l (c, -))^> 
i.e., Uosc,a 6l (c) is the smooth function on R x TQ 
such that 

Then, applying © and ([6]), 

(i,e 1 -- £ '(t)) = ^p/o (* e 

+| E£i CcA^Ai, ^)v; )d S 7r e cf (o) 

= Jo 4 ESi ^'f 1 - 1 (s/ei)V a °ds o 

+ Eo=i Jo itiX'^CV^d-otK?.^] 

- ESi Jo ^A'(V« 

-E&i/o'^'^C-i/q) 

Jo 1 J^^-Hso/eOdaodaiWjJda-^fCO) 
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Denoting by "V any vertical flow, we have 

(US^(t)) = ro^/;(r 



N >ei,. ..,£!_! 



+ Z^a=l A a 



TVq ,, £ lr->ei-l 



ft, 



s /ei,s)ds [V a °,X^ 



+ E^=i(AT( s ,< 1 s ;;r^\no 1 sc; c ' ei - 1 )- 



o 1 Jtte^so/e,,*) 



d So d S i)^° c jd S7r e cf (0). 
Noticing that 



,£(-1, 



and applying iteratively the same computation as 
above, one ends up with 

(*,#'•"*(*)) = 

r o /* (A e + X a {s)V l a + ds 7r e ef(0), 

where 3T(s) is a sum of terms of the form C( s )^ 
where V G x TQ) is independent of the ej, 

while C £ C°°(/,R) is of one of the following four 
types: 

1 6i,...,ei_i ( 
p s 1 a ., £ iv)£.-i , 



Ci = Jo j-UoscX* 1 (s /e i ,s)ds , 

c 2 



C.3 



2A T ( s.u 



Elr-i f i-l ^lf-i^i-l' 
; «OSC,C 



1 „ ei,-,e.-l 



rs 1 
I 11 

JO ti osc,b 



(so/ei,s)ds 



s j_„,El.->i:i-l 
ti 



-Uosc,c " ^(so/ei, s)ds 



for i = 1, . . . , Z, and 



1 ei,. 
— 



s /ej,s)ds 



T-iiosc,'c' ei 1 (s /e i ,s)ds 



e 

for i > j, i,j G {1, . . . ,/}. 

We are left to prove that every J* C( s )ds converges 
to zero uniformly with respect to t as e goes to zero 
(Lemma H3J. 

Applying Lemma 15 . 1 1 with 

f( T ,s)= Uo 1 sc,a £l " 1 (' s o,s)dso 

J 

and e = €j leads to 



/ Ci(s)ds < Cci(ei ■ ■ •e i _ 2 ef_ 1 

JO 



2 \-l 



Similarly, 



f C2(s)ds<C(e 1 
Jo 



Taking 



/(T 'r } T^^' 6 ' ^ (S °' S)dS °) 
(/J" Itosc.c ( s 0, S)ds ) , 



we obtain 



f Us)ds<C{e l ---e i . 2 )- 2 e-\e i . 
Jo 



Finally, with 



rs/ej i)| ei,...,e 3 -_i ( 



we have 



/ C4(s)ds < C(ei • • -ej_2ej_i) 1 (ei • • • ei_ 2 ef_ 1 ) x e;. 

JO 



Hence, each £ satisfies 



C(s)ds < 



Cei €i-i 



(ei ■ ■ ■ e i _ 2 ) 2 ef_ 1 ef_i (d • • • e^) 2 



and it is easy to prove by recurrence that 
• • • e«-2) -2 tends to zero as e goes to zero. ■ 

Remark 5.5. As in Remark 15.31 the hypothe- 
sis limsup e ^o r]i(e)/e 4 < oo in the statement of 
Theorem 15.41 can be weakened by requiring that 
limsup e ^ r?j(e)/e 3+a < oo with a = y/3 - 1 ~ 0.73. 
Indeed, with this choice of a, 



2^2 



ere; 



l c 2 



r? 



i-l 



C, 



3+a 



so that 



e i-2 fc i-l 



i-2 
3+a 
i-3 



«2 



Hence, each J" *£(s)ds goes to zero uniformly with 
respect to t G I as e tends to zero. 



Under special assumptions the relations in (|24 
that have been quantified in Theorem 15.41 can be 
reduced up to lim e ^o Vi( e )/ e2 = as stated in the 
following corollary and illustrated in the numerical 
simulation included in Section 15.2.11 The required 
assumptions are stated in terms of the number of 
steps in the algorithm and of the coefficients provid- 
ing the parametrization of the reference trajectory. 

Corollary 5.6. Let S = (Q,V,Y,&,R k ) be a 
FACCS. Let i G N , be defined as in (Tfy 
and assume that span R ^2(g) = T q Q for all q G Q 
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and that for each i G {0, 1} and each Z G 3?i, 
(Z : Z){q) G span K (^(g)). Fix a reference trajec- 
tory 7 re f G C°°(I,Q) such that the coefficients X a 
associated with 7 rc f as in [26\) are constant func- 
tions. Construct ^ ei,£2 , u £1,e2 and rji as above. If 
rj2 : (0, +00) — > (0, +00) satisfies lim e _»o ^(e)/^ 2 = 
0, £/ien e 1— > u e ' V2 ^ is a one-parameter tracking con- 
trol law for 7 rc f . 

Proof. The hypotheses of the corollary and the ex- 
pressions of the controls appearing in Theorem 13.31 
guarantee that the oscillatory controls are as follows: 

^osc,a 

(r,t) G span R {(^ jo (r)}, 

t) G span R {(^ io (r), — ^(t/ei)^^)}, 

where j , J1J2 vary in N. 

Thus the integrals of all the terms ST that appear 
in the proof of Theorem 15.41 only contain product 
of trigonometric functions, more specifically cosines 
and sines and converge to zero uniformly with re- 
spect to t as e goes to zero if 772 is such that 
lim £ _ >0 ??2(e)/e 2 = 0. ■ 

5.2.1 Numerical simulation: submarine 

In this section, we illustrate the method to obtain 
a one-parameter control law in a concrete situation 
that fulfills the assumptions in Corollary 15.61 The 
algorithm described in Section 15.21 has been imple- 
mented with Scilab. 

For our example, we have the submarine pre- 
sented in Section 14.1.21 whose dynamics are given 
by (|18p and (|19[) . We consider the same kind of 
inertia matrix as in Section f4.1.21 taking 

Ji = 1, J 3 = 3, Mi = 1, M 2 = 2, M 3 = 3. 

We recall that in the case under consideration The- 
orem 13.31 cannot be applied. However, our method 
provides a one-parameter control law that solves the 
tracking problem. The trajectory to be tracked is 
given by 

r(t) = (-t,-t,-t), A 33 (t) = l, t€[0,l] 

with initial condition r(0) = (0,0,0), A(0) = Id, 
being Id the identity 3x3 matrix, 11(0) = (0,0,0), 
-P(O) = (—1,-2,-3). Thus there are degrees of 
freedom in the attitude of the submarine, but the 
target position of the center of the submarine is fully 
determined. 



4 • L0 7 




4 • 10 1 ; 

Figure 1: The control law u 




Figure 2: The control law u 




Figure 3: The control law u 
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In this implementation we take 772(e) = e 2,5 be- 
cause the considered reference trajectory satisfies 
the hypotheses of Corollary 15.61 

First, we compute the one-parameter control laws 
u^ 1 ' 62 , u^' 62 and u^ ,e2 as described in the proof of 
Theorem 15.41 Then we fix e = 1/39 ~ 0.0256, so 
that 772(e) ~ 0.0001. The corresponding control laws 
are represented in Figures [Tj [5] and By construc- 
tion, the controls are highly oscillatory. 




Figure 4: Evolution of the position of the center 
of the submarine with respect to time. The target 
trajectory is the non-oscillating curve. 




0.0 0.1 0.2 0.3 0.4 0.5 0.0 0.7 0.S 0.9 1.0 



Figure 5: Evolution of A33 entry of the attitude 
matrix with respect to time. The target trajectory 
is the non-oscillating curve. 

Then we integrate the dynamics of the system us- 
ing the numerical integrator stiff included in Scilab. 
As a result, Figures 0] and [5] show that the target 
trajectory, corresponding with the non-oscillating 
line, is tracked by the oscillating curve. The error 
of the approximation, computed by the supremum 
distance, is d((r re f(i), ^33,ref (*)), (r(t), A 33 (t))) « 



0.1903. 



6 Conclusions 

The previously known sufficient conditions for 
tracking were given in terms of finite sets of vector 
fields, as reviewed in Section [3l Here we have con- 
structed a sequence of infinite family of vector fields 
that defines a sequence of convex cones suitable for 
characterizing trackability (Theorem 14.41 and Corol- 
lary U3]). Different convex cones, ([9]) and (fl"6j) . have 
been considered. Under additional assumptions, us- 
ing the cones in (|16|) and a particular sequence of 
finite families of vector fields, it is possible to recover 
the sufficient conditions for tracking already known 
in the literature [5], see Corollary 14.71 However, our 
constructions not only recover the previously known 
results, but they also extend them, as shown in Sec- 
tion su 

The sequence of families of vector fields in Corol- 
laries H2] an d H2] are also suitable for constructing a 
one-parameter tracking control law (Theorems 15.21 
and 15. 4p . It remains as future work to generalize 
the construction of one-parameter tracking control 
laws when the sets © , that include the closure, are 
considered. 

Another future research line is the study of the 
complexity for the control-affine systems considered 
in this work. Apart from tracking non-admissible 
trajectories, one could impose more requirements on 
the solution to the tracking problem, as for instance, 
to save energy. The complexity provides a good tool 
to formulate this kind of problems and, so far, has 
been only studied for control-linear systems [8]. 
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